10/500117 



1/18 



INCLINATION SENSOR 
SIGNAL 



26 



' CONTROL UNIT 



I 

k 

k 



ENCODER 
SIGNAL 



I SIX-AXIS FORCE SENSOR 
l_SjGNAL 



DISPLACEMENT SENSOR 
SIGNALS 38 



Fzt 



MX iO^'^My 
x4x F^^Y 




22L 



10/500117 



3/18 



FIG. 3 




4/18 




10/500117 



5/18 



FIG. 5 



START 3 



READ L1,L2, L3, L4 




-S10 



N 



DISPLACEMENT SENSORS 
ARE ALL NORMAL 
F^O 



AT LEAS 



SI 6 



ONE OF 



DISPLACEMENT SENSORS 
IS ABNORMAL 



END 



Ln 



FIG. 6 

iFn 

Fa n T fFbn 



Kb 



Ka: 



Xn 



1 

|Fn 

IN THE ABOVE Fn=Fan+Fbn 

Fan=-KaLn+Ci 

Fbn=-Kb (Ln-Xn)+C2 

Fbn=-D*:^Xn 
at 



6/18 



FIG. 7 



10/500117 



18,20^, 




FIG. 8 

90 



1 



(a) 


INPUTS h. 0x. 0y 


QUANTITY OF STATE 


OUTPUTS Ff bz. Mf bx. Mf by 




> 


Xn 


: 



90 



i 



(b) 


INPUTS h. ex, 0y 


QUANTITIES OF STATE 


OUTPUTS Ff bz, Mf bx. Mf by 




> 


hst, 0stx, 0sty 


>■ 



10/50011? 



7/18 



FIG. 9 



S108 

\ 



G=C+1 




ONE OF DISPLACEMENT 
SENSORS. SIX-AXIS FORCE 
SENSOR AND CYLINDRICAL 
RUBBER MEMBERS DEGRADES 



S122 
— L- 




|S I X-AXIS FORCE SENSOR 
IS ABNORMAL 



Is I X-AXIS FORCE SENSOR 
IS NORMAL 



END ^ 



8/18 



iO/500ll7 



FIG. 10 




10/500117 

9/18 



FIG. 11 




10/18 



10/500117 



CVl 




11/18 




12/18 




13/18 



FIG. 15 

64 



i 



382ayv 




70a y/T^ 


yv 70c 


382b yC 


382d 


70b 




382cX/ 





14/18 



X 




o o 

CD O 

in 



10/500117 

15/18 



fx 



O 



o 
o 



o 



^tr52 rs] X >» 

^ ^ ^ ^ »^ ^ 
— Q- O ^ i_ i_ 

tZ S CD CD 05 
CO Oc. u_ u— u— 



CM 

o 



X X >> 
^ -Q -Q 



GO 
I-IJ( 



LU Cc: 

— o- 



7S- 

ca 



I 



LU 



CO' 

LU 

-J 

C3Q 



I— --i: 
oo h- 

LU OO > 



CO 



CO 

<ct> 



o:: 
o 



[ OQ LU 



OO 



X 

oo CO 

— . oo ^- 

X Q£ I— S 
-< LU O =5 ~ 

I CJ> OO Q- rsi >• 

X ct:2r CO CO 

— O LU ZD M- 4- 
OO LL. OO O U. S 



CO 

^ z: LU ^ '^T: 

CO *^ ^ -< CO 

^ LU -a: q:> 

LU"^-^!— CO 

co< 



oos 



CD 



X 

CD 



/500117 



16/18 



FIG. 18 



c 



START 



c 



S200 



S202 

v 



JUST 
AFTER 
POWERED^ 
ON? 



NEW 

CYLINDRICAL/ 
RUBBER 
MEMBERS? 



N 



INITIALIZE PARAMETERS 

(SPRING CONSTANT K, 
DUMPING COEFFICIENT D) 



S204 
1_ 



DEFINE PARAMETER PERMISSIBLE 
RANGES 



— J — 
S206 



SET PARAMETER PERMISSIBLE 
RANGES STORED IN BACKUP 
MEMORY TO ADAPTIVE OBSERVER 

T 



S212 



S210 



RIGHT 




WHICH LEG 

SUPPORTING 

LEG? 




S214 

1 



S208 



CALCULATE AT RIGHT 
PARAMETER IDENTIFIER 
WITH RIGHT LEG SENSOR 
VALUE 



LEFT 



CALCULATE AT LEFT 
PARAMETER IDENTIFIER 
WITH LEFT LEG SENSOR 
VALUE 



— ! — 
S216 



S218 

( 



ESTIMATED 
PARAMETER 
VALUES ARE 
WITHIN 
PERMISSIBLE 
RANGES 




DETERMINE AS ABNORMAL 
AND STOP WALKING 



S220 



PERFORM OBSERVER 
CALCULATION OTHER 
THAN PARAMETER 
IDENTIFICATION 



STORE ESTIMATED 
PARAMETER VALUES 
IN BACKUP MEMORY 



-S222 



S224 



END 



17/18 



10/500117 



FIG. 19 



DETECTED AND 
CALCULATED VALUES 
FOR RIGHT LEG 



IGOR 

_L_ 



ADAPTIVE OBSERVER 
FOR RIGHT LEG 



DETECTED AND 
CALCULATED VALUES 
FOR LEFT LEG 



PARAMETER 
-STANDARDIZING 
PROCESSING 



ESTIMATED OUTPUT ERRORS 

FOR RIGHT LEG 

FferrzR 

MferrxR 

MferryR 



-104 



ADAPTIVE OBSERVER 
FOR LEFT LEG 



100L 



ESTIMATED OUTPUT ERRORS 

FOR LEFT LEG 

FferrzL 

MferrxL 

MferryL 



• k . if. - 



io/500117 



18/18 



o 
o 



o 
o 




^ . , . . I 

[COLl.Ll.IM LU LU LL. S Sj [CO Ll. LL. Nl 



S or V- 
— O L L 
J— <D <D <D 

CO q:: H- M- 



